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(54) REMOTE CONTROL DEVICE FOR MANIPULATOR 

(57)Abstract: 

PURPOSE: To improve the operability series by 
independently computing a relative state by an operation 
series control system and a working series control 
system operated by means of a work message. 
CONSTITUTION: A ground series control system as an 
operation steries control system comprises a central 
processing layer CPU 101, an image measuring means 
102 connected thereto, a graphic display 103, and an 
input output device 1 04. An on-track control system as 
a working series control system comprises a central 
processing unit CPU 101, a image measuring device 102, 
and a slave arm input output device 105. An on-track 
series system is caused to execute a work according to 
a command from the ground series control system. The 
respective CPUs 101 for the two systems individually 
control a work environment model, and perform control 
based on respective image measurement results such 
that working environment where the working is actually 
executed is kept equal to a work environment model, and 
work image level communicated is carried out therebetween 
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pcosy tCOS/9 i cosy isin/9 isina £ 
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[0 03 2] g/c, ffl*AA*B2 0 9fcJ:OA#$*i 

fc@««7 1 *ufcr^^2 l 3r*^T4fft. *^u~£ 

S^SffiHi® 1 0 3 <DT-jt -Is 3 >gM6tCSfc^jVr* 

r^EH t tr 5g&5H> r - is 3 >B#^te:St^r ^ 5 

[0 0 3 3] ft*, COR^^jftiiABKS2 1 

■MkA^mucrti 5 c i & < sfc 5 <t ^ cci^e-r 

[0 0 3 4] S£*C. H4fC^L/fc<fc5CC, imia2;£S 

ItC^/A S^fUM^^2 13SIW6 
^f¥T-5^CC«, 7X^7-A2 0 1 t<Dj3fat<Dmifc 

S2 0 9 iXU-^7-A2 0 2 (D^fr£l«iET£ffi« 
fflftvh >;**£R i 
TsS=Ri • K • T 6 m 

St8T£C£&< x ?x^7-A2 0 1 SrSfrTSC i 
R i • K«ffiS^iE»n^g2 1 8KJ:<9# 

[0 0 3 5]CCr. i#B01H«A*««2 0 9CD« 

[0 0 3 6] 
[K2] 



Ri = 



— smy tcos a , 



cos y i sin/9 jcos a t 

, . 0 
+ siny tSina t 



siny iCos/9 i siny iSintf i'sinai siny iSin/9 icos a t 



— sin/9 i 
- 0 



+siny icos a t 
cos /9 iSin a s 
0 



-cos y iSina j 
cos 0 i cos a : 0 
0 1 



[0 0 3 7 ] C©J:9ft**BBH^h y -^^R^A 

iWtfcWfiLtr*. ±teoge<jcDis^, r-AS^ccj: 



P. q « r 
[0 03 8] 
[K3] 



50 



R i = 



(7) 
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|-cos C cos e ccs C sine sin 8 cos C sine cos 5 

— sinCccsS -!-sLnCsin5 

sinCcose sinCsinesinS sinCsinecos5 

+ cos£cos<5 — cosCsinS 
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— sin s 
L 0 



cos £ sin 5 
0 



cos S cos 5 
0 



r 

i - 1 



[0 0 3 9 ] i^-rc <h#r# 

coo40] ;xic. *mi<D& *>— -zxDmMWzmi z 
jfc©ffia©»*aasLK:*f u . * *■ - jwst»a»*tT ^ 

&©£. - A 2 0 2 (Dfjfe©a^fii l/t 

0 1©SJPM«L^£M. a«aES3RM*6"^^irr-^ 
2 0 1 ©#**r©M@atv h 'J ?XT,m. X^r— 
;U^&?SSJM?©fcS0©^&v h >; **£K£-r<3. g/c 
XU-^T-A2 0 2©£%ffiftaft-7F- 'J^^%T e 

d T, = J dQ 

(J : -fatffTJU) 
4\ v^$7-A2 0 l^at/hilttMDS-ttAii*. 
©&M»tt©Kffi©afl:* d Q £ U 7X$7-A2 0i*; 

d T, m= J m • d Qm 
CC-CdT l m%^-^il/^l/-7'7-A2 0 
2 ©#5fc©SWjISfr d T. s *%5tt> 6»£ „ ★ 

dT,s = KdT,m 
3HC * I — /7-A2 0 2 ©»«l«Stt«>«/J^ffi d Q s 

«u-y7-A2 o 2©+3fcrfswj sommi/ft 

dQs = 1/(J s) • dT, s 

±sj-cf# e,nfe^u-^7-A2 0 2 ©s-Kigsifrcss/h 

»Qs^ l/-y7-A2 0 2 ©&Wgp$A©ttSfC 
»Dx.. Cft^b-^7-A2 0 2<D&MBWl<D-f-tf 

[0 045] 'AI,C±.mL-tcjWmtCi>tH>Xj>:$m<Dffl 

tsaae©ftcMtitw*ia8*ffli,»TSiwr4. s> 

3 ^fY^207, mm\t)2iS.2 0 9. ^ 5 a U 

-~>h>#©2 i 1 3?©&&t,>«:-x>-ctt. 

i£0£<Dt\ CCt«7Xj'7-A2 0 1<b7;W-7'7 

-A 2 0 2 ©H«©#«coc»-ciiM!-rs. 
[0 0 4 6 ] H8K*»i,»Tia2. 3£EJW#©6©ttR 
-gp^*fc(«BS-r^S|J^r*5„ 7 0 1 iJM^EJSS. 
7 0 2tti9#@8Sr&-5. M^@SS7 0 1 »^>7 - >;> 
^•/A(Cfelt^>t2 1 4 A~2 1 4C©-fe>lHI 

^©^fc#*&tH-rs. ^^sasssio i«i»ifiufc 

(3)— C6)3rt?^Sn/ctf#€:?ft>. ^U-^7-A2 
0 2©SHfi5WCEatft»**aS». t©§£fb#£tf#[5]3g 



*&*D*>. VX57-A2 0 i ©•§■;> ^7.* *<h-e© 

S-SIgg|ft©ttS*>6ffi«S:kv h 'J i'XT.mW^ 
*l£„ SfcXU-7'7-A20 2©Sy>^5>if<t 

•£©#5fc©t£B£^-f&«^&v h y i^^T, s 
htititi. Xl/-7'7-A20 2 ©Stt©BlSffi*s*» 

[0 04 1 ].4*^*fvxa!7-A2 0 1 £*U- 
7-T-A2 0 2©jlS&€:l5l«!S-tf5fe© < t-r5£. ^ 
©*4»©6ft/J^t4d T. £ v-f ^ \s-~ZZM<DWY&. 
20 fidQi ©S(C^©RI^*SA 5 . 

[0 04 2] 

- (3) 

* 1 ©+•= trffjW* J 41/fci». 7X^7-A2 0 1© 
^5fe©SR/jNaJtt d T s m«^©S;^6f#6n-5.. 

[0043] 

... ( 4 ) 

★ [0 044] 

- (5) 



•• (6) 

7 0 ZtcHJATS. t^lHiSS7 0 2«^b-^T-A2 

?&tft**jl?Z>. ^U-7-T-AAtB^S2 0 6 tt 
XU-^T-A2 0 2©SHgp#{C^fcTi'5 i ^j:- 
£2 1 6 A~2 1 6C£fg»rr5. Ch^Tl-^aX- 
£2 1 6 A~2 1 6 CCCitl. XU-^7-A2 0 2[J 

40 mwj2ti*>&> *<Dmmtte&Bi&2 1 5 a~2 1 5 c 

CCio-C^tbSn. XU-^T-AAtB^S2 0 6(C 
7^-P;^i»3n5. -?•©$&:£. v^*7-A2 0 1 
©^5fc©SS&£ * * - u r * u - - a <o^-% 

[0 047] ±x6L//c*^W©MtUSS©M©IIJS0|{C 

l©&W®©MSte£S<2>3£A,r:te<. ^{c-7^^T- 
A 1 £* U-^T-A©|iggp^^A*L/. MS©^- * 
50 £©^6Kgpft©^{tJldQm=&3}cif)5 0 'XtCr-? 



(S) 
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>l' : £&mLX=.M8$%$:s£lb. ?X$7-A lot 3tf 
fT*JJin«ttM-S. m&M£itmdQmt-p^eim 

' J m*6-7^ir7-A l©^fid T,m^»5, 
X T -^ggSBEftK «A# $ titer"- 2 *J8lr*T . 

--7X£7-A©^3fcg&dT 8 miCK?r3gt;TX U-X 
7-A©3^fc3:firdT, s^ifc©*. ^JCXU-XT- 
A©+3Ka*frJ>Jl/J s COdT.sKl 
/J s£fgO-5C4K:<J:9XU-X7-A©:&|iBg3#^ 
lidQs^abXl— Xr-A©gflgpftQ s 4dQs© 
fD^ri^r^U— T'T-ACDStf-^CC^m^ta^-r 10 

[0048] C<DmfcWiC&tl\i s B2, 3«CijVrSUS 
W£R«fc8&*#»6ft*4#«:, v^^7-A20 1 
4XU-XT-A2 0 2<D#5fefig*li-C(C*>-,rfelU 
*8X*- Jfe-^eE*©;*^— Jl/gEffo&S 

[00491 01 1 (£*^?i<DS»0 £ 6«Cffe©3gfetflJ 
^TTK-rfe^-C. C©0K4el>-C. 02, 3 4l§tff-5§<D& 
.©tePI— SB#r*-5„ C©HS6Wi. XU-X7-A2 
0 2©#5t*iSUe-S-SiHfcAa§*«2 0 9©X-Ai£© 20 
^tfctfjcsor. -7X*r--A2 0 KDMmcZt-tzx 
U-X7-A2 0 2©SS&©xer-^^<D^^x. 
£ <fc 3 CC 0 fc & ©r * 5 . W&Atmg. 2 0 9 «c *© X 
-Ab>X©»#^ffi-r-5>-fe>lM 0 0 1 4R», C 
©■fe>-9-fWR*ffl8SCSB&IIIflS«2 1 8KA2JTS. ffi 

tl^&ilfln=£a2 i 8«c©-tt>-!fit«i-?»*8&ri» 

cfefe&siiai o i icmm^ikoma^mmL. 

wm&i o i«xi/-^7-A2 o 2©aa6*-7^5fT .30 

-A2 0 1 ©^ftKitf L-TX^-;l^&i&fT=£tf £fc«> 
©g&ffis&Slff-r*. HI UCfctvr. 2 1 3«rUt 

[0 05 0 ] ^(c±aOftu*l69!©«H©ffi©SaWI© 
SfrfE£01 0{C7FT7n-5 i + - f-S/BOTISWrr*. 
g-r#J8Hiarx*- bT-5 4. vXf7-A201O 
&Sflgpftrisg?^&£ft-5. »Cf-^^#BLt^ 
KH»©fia##©6ft, »6ti3t=AWI»©«*flH,»-c# 
5fcM«T.m#;Ss!>e>ft£. ftf&bfti.J: 5KIBHRA^« 
g2 0 9©X-aIx>X4|p$3;*-I±5*§-£. X-au> 40 
XCC§g&Ofc-fe>-? 10 0 1 CC J: 0 X- Aitastfcfcb;* 
ft. ^ir-^vh ';*XK#jfce5ft-5. X-AU 
> X 4 RJR L JQr C J* 6 * C ©A;*7 3 ft fcX ir - A> 
g»vF';«K*iffll,^ft5. ^K7X$7-A2 0 
l©^5t&ST,m«:K?-^Drxu-XT-A2 0 2 
©#jtet4«T, s C©T. s.k9]Kffift£&ifi 

jrc^U-Xr-^ 0 2©*Bffi©S«H*3jt«>. C 
ft*^l/-^T-A©*-9--!l«*«:a*r*. ±K»fls 

(0 05 l ] c©J:5K^ofcc flMLAJj so 
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«B2 0 9©X-Aj**ffl»cSi*.T6. 7X$7-A 
2 0 l©¥5fc©2564:?H^-£2 1 3±©X L — X 
7-A2 0 2©#$fc*«©Stt©**s©Jt**?ir«:— 
jsc«oc -e©MS. ^{cawfefiiffiffi^: 

[005 2 ] <B2©SU&0f) 
1. *2©XftWBi9! 

H 1 *ffll»r*»W©»2 ©SU6«*tt9!-r S. 
[0 05 3 ] *HJi{»J(i. StfiaSWi/XT-AiflSUR 
.Si^fAi^S*). &f]F3i i gg>'X^Att < 4»£ 

toasia 1014. ^ifetos^a i o i icmmznfcm 
mmm®. 1024. <p&mmm& 1 0 1 4®^ttiij# 
ui 0 2«:m^$ftfc^77 y -^f^^u^ 1 0 3 
4. <p&$mmm: 1 0 1 KggisftfcAaj^isa 1 0 4 

014. **Aaasia 1 0 1 &c®MSftfcii&if-irj^i8 
1 0 2swb-^7-A 1 0 5 tfr^mmztiz. c 

©->^fA«, mt3^±tc*'sf|s3ira***^u*» 
ff3R«S2^x a 4 f^H^^^X^ A©4>£fe9&a 
1 0 lWBWHcWmLX^Z. *BR«cfl9i«im>ftSf^ 
£SR« (09x««(iii±©^SMrt) iC©f^J|S-> 

Sftfc^) 4». iS#3tjS'JM^fc:S^^c^U< 

6©#<^r«i3»±©x u-xr-A*if^i*tf ^ 4*tc 
W. fi3e±-C©f^SI©jttT«:^ft-g-C. J^^g^x 

f-A©cp*«fflisafcwai©s/* 5 u-^a >*tf 5 c 

4(cj:9. M^fAif^I^t^-St^fto 
4. ?z>y<r v^-fXXW 1 0 3W, i^X-rA©^ 
jR*2f-^U-*(Cmb. AtffcfrSSai 0 4£JBWcaf--N. 
U- £ 4 ~>X r- A 4 ©^flWP©fcat>©^ > £ - 7 * 
-^©a«l**fc0rt»4. XU-XT-AA£B*ilS 
10 5«. XU-XT-A^$fI©T-5fc©©'ff#g©AtH 

[0 0 5 4] 2. *2©5tftfff©ff!Hg9! 

0 2 3 ^rfflu r ->x f ^mi&z-$m? 

[0 05 5] $->^fA«, glfP^gS->XT-A 1 0 

6. so*. fm?ti->xfA 1 0 7a>6#ja<*ft-5. 
fffiaaifp^'ga^x r- a 1 0 6 «. -> 5 ^ 1^-^ 3 >^ 

©2 114. fg>'5 i U-^ a >^g2 1 KCSiKSft 

tcmm\W£& 102. ^ffi^miiM 103. 
Atb^ai0 4, 1; 3 -f^f y ^Affi^a2 0 

8, 2 2 8. 2 i 8. ^3^X7-^^207, 2 i 

7. VX*7-AAtii?7£ta2 0 4, 2 2 4. 2 j 4. 
vx*7-A2 0 1. 2 j 1 4*^r«fiS3ftT^ 

©2 3 0 4. gv;f 3 U-> 3 >#82 3 0(C»$ 
n/cXU-XT-AAtH^a2 0 6. 2 2 6. 2m 
6. XI/-77-A202, 2m2. H^tf-S^© 1 0 

2 4 . mmtm^®. 1 o 2 tc^sft/c*^ ^ 209. 
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2 2 9. 2 n9 4*^/C«fi£$ftri,>-5. £*J. MiE 
is a A * T < v 5 AttJ^S. mZis 3 A X f < -j >? . 

*u-yr-AA£fiA£lg. s5ia^u-^r-A. mib 

[0 05 6] */c. is 5 ^ U-->3>#!82 1 1 4vjt. 

f a u - ^ 3 >#s 230 «a«#ecc i k> mKicmm 
[0 05 7] *mmmx\z. m-srmmm&w?mt& 

C0 0 5 8]. ( 1 ) aBfrt^I/OffiiS 

•*f\<H 1 07 (5. 3SR9t*^*©K9!#JK) 

<f ISS^e^H 1 0 7«c^$hr 

[0 05 9] ^U-«s. ^>7*. *>L<< W^-tf'- 
F^AfflTJiKgl 0 4^t, AW*? 8 ;!/ 110 7 

{CS^Ofc^fJ^CD^iaii. *jJ:-e©&g£iM.-2>4. 
r«tS^S (#KPP2 -2 0 9 5 6 2) J fBigCD®^tf- 

S<J#!810 2#s. tt»±fcK#*ifc«rt*©. jEttfcffiB 

a. tiriBBflttfar^su. 1 mxftvmmxmmmw 

ff-rs. i5su^tf-s'j^is«« faug^n^^Ai o 
6i. &rpjfi < gmisz.f-2* (jkt« maLtas*^*?- 
Ato<it*«:ftisjjfiii,»9> io7K«*c*h, 

*>72 09, 2 2 9. 2 n 9 teAs-fcmfefr 

coo60] ( 2 > &m±.rm<Dim 

1 1 o i ±vi^mit\s^)vcDmm unwrnj* 

istltt) {CckO. *^<\s-$WikmWw 1 0 3 4©*f 
IS^glff-CfftotiS. ift±lSeSi'^f-A 1 0 6tt. * 
•^U-##AfctS73§SHl 0 4^1l^rA*L/c^7 

[0 06 1 ] ( 3 ) *JJR £ttittJh£©ffttRjEfl| 

vLtmmmisskT-A 1 0 6*>6«ia±ifi^fA 1 
izkmrn.?-* (r?mtSiM*%. mw&azm) mm 
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vmtiL&mm. A\s-7T-A&s.m&) ^e.ns. 

[0 06 2 ] ( 4 > *U8Jh*(c J: *lfHfHlflMWT 4 tfi 

JlLfc*©^ 5 a U- >3 2 1 1 SC<«liiiJS©^ 

-f a |/-> 3 >#S2 3 O^^n^til 2ii 
1 3 *#«orfk«±3RK J:4tHBf¥j|©38fT 4*_k3R 
T?©f^lMiSicO(,irSi^TS„ SHI^fJH 1075 

f- ©regpfts©^^-?*- #«c^&3 ft. ffcus-ewflE 
■w^sti-s. «k±^-rtf4bnsfiP«©->5au-i>3 

^6*14. ^7"AfcS^*s^Ufc4*{c«, ifi_kJR 

sm^s 1104. *aLfc»»«*a 1 2 o 4&mii 

x, tSIBOr (jlsa*t3:tSHBl^r«js-c# 

5) . WHB?f*t*ifju *ftccj£&-c*fiW5. 
20 [ o o 6 3 ] 3 . mtmmmiss\7-A m±jtmwsss\ 

rA) 

3. lfltj&Otfflg 

t&ii^^a^^-rA 1 06Oi/5al/-i/ 3 ^g2 1 
ltt. 0 1 2«c^?nri,>5«i: ; 5«:, ^7-7-/'>->5 * 
1 1 0 0 4.. *7?JZsis=i l i 00{C 

WMiZtitcXls^Jlsisz. ib-Jl io 1 R£>'H6_h3f% 
^S^gl 1044. ^^-f^^Utz-^l 100 
SC/^>7^>^>3 * U-ji 1 1 0 1 fCg,«3n/t?g^ 
*fA«i¥gl 1 0 3 4. t7 7^»5 ^U-dr 1 
30 1 0 0 RC*3IW*?\M,flEB« 110 3 (CS^5 ntcT 
1 0 24. XVzrjlsisZ — 2 1 100 
KS^jnfcf-ifSf^ai 1 054. ^>5^>-> 

3 » * 1 1 o i fcs^jnfcf 1 - ^^im^a i i o 

6 4. •9H* i e9'**a¥ftl 1 0 3(cgil?n/c^^ 
^110 7 4mr^?fi5. frfE^-^^Wl/^ 
J'l'-f 1 10 011, ffm* y hy-i'^K^gl 1 

0 8 tfm* 7h7- 1108 (c«^?n/c 
^>^-7x-^*fjiai^i3i i o 94*^«fissns. 

t«ia^> =r A Is is 5 ^ U-i? l 1 0 1 », f-^^ .^7 

40 -tmm^fri iio4. »fSB* 7 h7-*ti?a 

1 l 1 0K:g«S3n/ca^v HS^^gi i i i 
4, bjK» h^^S#|gl l l lKS^?n/cn!jfi. 
h^fg««?^Sl 1 1 2 4^6«fiS?n-5. mrSS^^ 

f^flfgl 103«. ?7X7l/-AM#Sl 1 
13 4. *5*7U-A**^«l 1 1 3iCffiJhfc 
-f>^^>X7l/-A^gi 1 Hi. 4'sXZls 
X7^A^#gl 1 1 4 5cgM;*ft/c-r>**>* 

7u-AMff#si i i5i*6«wssn4. mrie3s^ 

•=e-r;H 107 (5. 3W&*7>l'(Dmffig.&) ^ 
50 7^7U-A4-f>^^f>^7l/-A)!P^i$h5. 
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[0 0 6 4] 3. zmn&Dwwa 

3f-77-f»5aU-$l lOOtt, iMifAl 10 

mrnm i o 3 iojwws^s^tff^ 5 tc&<Dmt& 

■ mg** F^-i'&jjfgl 1 0 8», A Hi 

S1109B. ^U-i<i^l/-^ffliillO 

3 ±(Dtf&#MrE£$m-tz mwosma, i. io 
[0 06 5] ^>7-r>^5 ^ i i o ia, ftm 
■r-^^jjW*. r?m*v F7-*wifsi.i i o 

or, p*'* hlS&fc^fSi l l ltcg-r. cuff* h 
WH^^Si l l i«, rm*vhKr-9KMn*x 

£° 20 

[0066] aw^finrai^a no3». -f 

*— ^WW-^Sl 1 0 9>£^L.tA*^n.5t^U-$ 
cdJ&tk I«ttffg 1 0 2 {c J: -jt A^JS ft-Sif-l!!^ 

- # - ttaLhfi9ito»T ^ mimmtomgrix £* «c j: 

oT. fHllWItiJWt-tfJH 1 0 7 i<Ofa«:^-®*s^a 
Ce^^^KSttfM 10 74flt5„ 5=77, 
? U-.Mft*#»l 1 1 3 6*. Aiti^ga 1 0 4 *J8C» 

*5X7l/-A (5. 39Kt«9 r JU«DIHI#JfR} 30 

ra. -{^$^7i/-AMfSiii4tt, m 

u-AMlr#I21 l l 5tt, H^ftiUffl-? 3 , -f 

#8111 2*»6aSf.Sf f -*{c*-3i»r, -f>*£ 

[0 06 7 ] 3? 1 1 0 2 tt, SgtefJlt 1 1 0 

•^U-^Stk^IS® 1 0 3JC*^-T-5„ f-^Sfgg 
1 1 05»|ftitS©Vif J LU-->3>#|82 3 0*>6 40 

»5>tir< s^-ir^jwrrs. ^-irasesaKi 1 o 
6 «fiiavr-f^ i/-> 3 >?g2 3 o^7-$ zmm 

tt«*Kaur. SS**ha*7 7^>i>;aL,-4i 

i i o O'sjifcrrs. 

[0 06 8 ] 3. 3MfE4>|g9§ 
<XK. 8Ka*f\>H 1 0 7©ffr£B$©^*^A©t&flE£ 

Mwrs. aw*^n 1 0 7©mb?(c«, ^^u- 
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r. loio^n-irxaffiKoyn-fe^tcfcci^sffc^n 
titctztcvmbu. ^A.^t^ormtn. com* 

[0 06 9] tCT, ST, aJ--«U-*{CJ:5SMtfSij* 
7a*x&WH?z m -0$7*-z.ftffl^&i i o 9 

b. 7i^-* i i o ztiir.. Sffi^i 7*-yia 

7> F^-a-£:st-~;u-£Ji7rU||jggi q 3«cfcB2jT 
S. t5i. tf^ u- *{|^HB i o 

0 4€Mt»rfHW»1W**5^«»*A*r*. CCD 
-/>^-7i-^§IJ®j#©i i o 9^?> 

ur. snte^Hra^fti i o 3-®^<t,s„ am* 

T^/Utf 1 10 3TB, ^ -7 X^fttfCffi^-r 5 2 =7 

jii i o 7*^^?to. ^vx«:ji-ra-i'>^^>^7 

U-A (5. 3SM«^CDttlS*Jffi) *£jS&(,rJMt 
*f*Al 1 0 7(CdIiDf -So — T~j( — % 110 2 

fa^iiii o 3 jc^^ta m^fjKD 

IP, ^-<U-^^ffiE®ffil 0 3 JCS!*^nS„ 
[0 070] ^^^«cJ:4faBf**(t©fflil»jE*tf 
tt.ii^KB, -f>*7*-*WaP#gll 10 9#, ^ 
^SBt3*3cSt (fHt^ttttffiCSfll) (c£& 
fSi, -f>^3f>^7 U-AMff^Sl 1 1 

{ig^a? h (5. 3^S^-f\>U©tftHj#flg) *E^fr 
5. 

[0071] 'Xtziszf-Aic^zmivm&mtffly'u 

<t*(c«v>^--7^-x$)jtai#©i i o 9^e,m$n 
*iB«9KHB*«cas-3i,»r. BiMtrn^ie 1 o 2 ^ 

^>^7U-A|^ffgl 1 15B, C<&ff-a!HB{cg-? 
hSrBUft-S. T-^-^ 1 1 0 2«. 

ctih <Dwmv®i* wmrne 1 0 3 tc&jj 
[0 0 7 2 ] oirjc. $km±rm<Difmtnm^m<Dm 
[0073] jyz? *-z&m^mi 1 0 9#, 

1 1 0 2^5>LT, ^^U-^Ji^fflBM I 0 3 

tcse^T, Affirm 0 4«:ffit>r, 

fBK^ yt-^A*T5. -< > >*7x-^${J®^gi 
10 9B, A^$tifcf^|y 7-fe-V«aHRQ. f^g^. 
v h ^-J^gl 1 0 8{CgT. Titi^m^v h 
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10 8(1 fEJfcrf ?«-£?«MSfll' 

r. rm*v Y*7-2*&.mrz> (5. 2^^7 

. h C7-^«S#|gl 1 1 OB. ^(✓-^e.Ofpll 

b?-ir*a#y hf^fgl 1 1 l(c8t. 

hm^^K^S 1 1 1 1 B. fPJiigig^T^ 110 7 
£#BSl<£#6. f»*9 hy-^S&fM*— 7 (ft 

p#-j f-mf§BP*Kv h#fg^f?^Sl 1 1 2{c^3 

n. btmmm^i 1 1 2 b. ptffy i-sis* 

AMfffMSl 1 15fag1\ >f>.X*>X7 b-AMSf 

^ei 1 1 stcjzzmmtrJi' 1 1 0 7cd^>;*£>* 

7U-AM$rtftSB, IP, T-^--£l 10 2£;fM, 
T, ^U-£iim/BiIi® 1 0 3«:«^3ft3. C©4 
3\ tf^U-SB. 5f-^U-*!6^/BPi® 1 0 3 

[0074] tt±JRIS»#« U04H, ^Zy-AVm 

* 1 1 0 ofcaarr*. st. a±»Ka*si 1 0 4 
[0075] 4 . («iit_b^es'> 

4. l«/8©tfcHj§ 

flat.BfctrSi'X^A 1 0 7©7rtal/-^ 3 ^g 
2 3 0(t >S/S 1 1 0 1 4. 

10 1 JC^S^ftiiR^^rx^a 
#©110 3, Xb-^7-AiMWll2 16S^f 
-*SfllS*l 2 0 5 4. ^U-T'T-AftlJtaJiSgl 2 
1 6 KftttSftfc?*- jrjJSfiSSB'l 2 06 i, «lS_LS5 
Ett^S 1 204i, SBt-fcfJUWlf® 1 1 0 3 icm 
mztiltm&effi' l l o 7 <t*£A/c«W53*i"a.> 

3. iiiIS^>-7-('>->5 3 P-^ 1 1 0 Hi, fBg*v 

Rl.l 1 0Jc«ttStifcn#y h«i§£^Sl 1 1 1 

4. p^-y HSSS£fiS#Sl 1 1 UC««Sh/cn# ? 
h«H»f!*«l 1 1 2i^6«^Sn5„ ifrte^* 
■r Jl/"gS#© 1 1 0 3B-/>^ii>X7 U-AMSf-PS 
1115 *^rflteSS*i. iS^ttS'J^S 1 0 2 (C«*fc 

msenK^i 107 (5. 2#ko «, * 



(11) #I?6 - 1 1 4 7 6 6 
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-5. x-^^t^a 1 2 0 5 ^x-^^ff^S 1206 
B. itL?(0 , >5al/-5/H>fa2 1 1 ©X-*3^ff 

ssi 1 0 6a^f-f§^ai 1 0 5 t-zti^nm. 

ffnltlii&^-C^S. XU-^T-A$lJ®lSai 2 1 6 
JCB. flMUttfE^gt2 6 0&O'* Ix-T^T-AA^S 

ai osamssfts. 

[0 07 6] 4. 2&fg©i&l£ 
3f>7^»5iU-irl 1 0 IB. mil*;; YV-Z 

10 ms* y h 7-^<gs#s 1 1 1 o«. rm* » v 

^S1 2 0 4*6©S$ (6. ->^f AO$^fi# 

j«) {cjed-c. p#? ns&s?si 11 itcitr. 

hSH£fiS#K 1 1 1 1 B. ft** y Yo-?& 

%u#v bwmmm^mi 1 1 

2«C«r. P#s> h mf§8?«?#© 1 1 12tJ, Utf y v 
1 1 0 3 B. BflkfHK^K 1 0 2 ic JcaffSH?* 

20 r. f^J8^ <t mUBS^ 7 r Jt' 1 1 0 7*i^(C^L< «c 
Si^fCiS^^H 10 7?:firi.. 
[0077]f-*5ggH 2 05B->SaU-*/ 3 
>#S2 1 l*>6ill6tir<S7 r -^?:Sft-r'5 <> X- 
^j^ftSS 1 2 0 6 itmiE^ $ib-y 3 >^g^f- 

->5*U-3?1 1 0 0-^jI&JT&. ^l/-7-7-A»« 

sai 2 1 6», x\s-zfT-j*$m?-*%m$.L. 

30 XU-^r- A 12 16 B, $»M&«ff 5 ti 

[0 0 7 8 ] 4. 3ttfE©K91 

h'J-i'tlfiai 1 1 OB. ^-^U-^*6 
f«* v. b 7- SS**«W«4 i. 7 h7 
-i?*u#v hSa^JsE^Si 1 1 neat*. p,^y h 
S^^E^ei 1 1 1 B. W%.^r>l> 1 1 0 7£#I?t/ 

^fi©C<t. I^JfflB5. 2-C^S) ©U-^Jl/«:$f Jg 

J5Xf 5fi*IT. i®«tf-?|fJS**5-Cfcii^«CB. ftS'Mm 
tca-3t»TJ»Brt 7^1/1 1 0 7?r^IEUr. CMti 

B. P*? hSS0W#Sl 1124. 

1 2 1 6{Cig?ft5. a^'y h#f§g?S?#© 1 
112B. P*T-? hSfi?:SS?br. XU-^T-A^ 

50 ^X7U-AMff#®l 1 1 5CCjgT. XU-y 
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10 



20 



-g2 0 6 tCg-T. *%tCgtiltJb$I^#& 1 2 0 4«. 

•aLh««a^^?-A i o 7©»mss (a*©***) 

£. to/SSCc. ttaLkJMKSJ^f-A 1 0 7£#it;*i* 

{0 0 7 9 ] 5 . afrfcs: 

5. 1 ff IgSfcfe JKDiiM^JB 
-Xic . I144#il r 3£5S»W©ift±« £ «ti£±$ £ 
©IH"C8l»)S'toSh5iWl*a:*tt9irs. if!LfcJi5a>6 

tkaujRjci*, fai*?. h7-*£, tft-h^^a^iai 

S^tf^Jffi <fBBtt*8ri*©ttX£&|») £«iaLb%£ 

a#fii 2 0 4*>&©y ^-y^i^hs. 

[00 8 01 ^1 4KS*tilt*S» < r-z^-xm 
mi 3 0 0. ^U-->a>3- F2SfI 1 3 0 1 . 'J £ 
->3- F«©1 3 0 2. ttJJM^iJfittiJZff* 1 3 
0 3. ttS— 3c? 1 3 04. ^U-fiVjBSBIl 
3 0 5: MmaSMS 1 3 0 6. t=- 1 3 

0 7. ^l'-> 3 >3- KSff 1 3 0 8. U$r->3 
- Fjgflf 1 3 0 9. flLUfi. «lil±S«i52itSL 1 3 1 
0. tKft— a? 13 11. 4^U-S/a>BfjMm 3 

12. mnmmimi 3 1 3©**je*d//c*j5*sft* 

carry (A, [ Pi P2] , 8) 
: «J#A*«6^Pl£fik.#.P2*aorllL^BS-Ca-S?. 

[0 0 8 4] ccr. a£ B«^t«:fHSI^^H*©«mr 
f. Att&-&4>©. «4A*aW13-&*t>©*JS^-. rl£p 

SH£ja#a hub, &.Tic7ik-?m§$MMic'&^ * c o o 8 5 ] 

carry (A. [ PI P2] . B) 

= grasp (a) —path [P1.P2] -»attach_to ( B) 
C©5$TC«. grasp (A) £ attach_to (B) #3frfip;** * [0 08 6] 

grasp (A) = approach point-»grsp_point 

attach to (8) = approach point-»attach_point 

SC (3) £5£ (4) BttfM* — ^©JRH3C"C*4. cn 

6©^©approach_point ("Oif©I&fPte:Stf;fc«>©S 

WCUC. s£») J fgrasp_point (ftfWBfcftftaDfcAK 

Xl/-^ • U-*#&#£6&ttfttf&6&U 

fig. £&) -?>attach_point Bfflr* A: 

ftt»tia. s&) «. f¥J£*f&«j<* (AJbiuttB) © 

tfJH 1 07©ASfcBB5CHto7U-A (5. 3 
#88) £#8ST5. S 6{Cgrasp_point£attach_poin 50 
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: 4. 1 3 0 0#>6>#J!H 1 3 0 6 £ -C#i£fHIl©# 
A. #AH 1 3 0 7#>6#^B 1 3 1 3 * T***flMH©#JIR 

r*a. 

[oo8i] *jWB*aw>iW^*^«citti»-r s. g-r. 

^JKl 3 0 0riHftfliJ*S7 :: -if-<-^?:^ffr5£. ^ 

jm 3 o Tz&mm&T-z^-xz&mtz. -xic. . 

#W1 3 0 1 -C^tffliWS^^U-^a^n- K?r^t 
&£. 1 3 0 8-CSfsM*«*^U-'>3 >n- F£ 
Sff-r-s. 2ttc» i 3 o 9 rsMffld** y £->3- F£ 

&<rrS£. ^)E1 3 0 2r^ffliJ*S';^->3-F?r 
3MT4. 1 3 0 3 £#«H 1 3 1 Or^MffliJ 

l», #ffi 1 3 0 4 £^J® 13 11 rttiJR£lfcit±»© 

C0 0 8 2] 5 . 2 f|sj|* 9 r y-9<Dmi 

r fHft* 7 hV-i'Ml 1 0 

a^u^^©f^^fpa*^^-c*a„ fai* ^7 

4. CCT\ fHi*-? h-7-^©HB5Sfdcarr y ©IB^ 

^ffi£S**^-r. 

[0083] 

(7) 

30* T, STfEigl* -^ h ?<Dl"<Mcm 
§§-r5„ o^(c. WSS-tf 5 ;!/! 1 0 7 4#ML.**6. 



(8) 



(9) 
(10) 



«4. jEiS^-o5S^^fig^a6»S4^^3^4S6^ 
©-C. approach_point«:^/c£^«:||ffS , J-r5„ C 

(0 087 1 5. 3 mm^fjisvmi 

8S3£*7\>H l 0 7«. 7 U-A^iS-ctaMStiro^ 

7L / -AOTKtt^<-7*>©^D5 sil^nri,^ 

5. ^{C^ D 7 h ©T«C«7 r ^ y h . 7T->7h© 
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i o 7©«ii*sewrs. * (0095] 6. s&j^^s^T-AcsMsoJs^- 

. [0 08 8] S^if/KJ, #777I/-Ai'f>^$ ( 1 > W«±*S^^m 2 0 4 tt, '«WBa«£*. 

x*>XBT&l£JI«:&oTi,»-5. ?5^7l/-A(c [0 09 6] <2> f»W*#±StfT*6. IWLbJfi 

*^r. t>^>yMiai') w?ns„ to 09 7] 6, 4ti±^®g^xxA©&®<3Di©^- 

»ftr*±r©#«*Easr*Ktt, asottf*-**^ ( 1 > tajbjssm#Ms iio4«, ji*t*iip8£«. #1 

©<fc5«C. ^5XK:B&-?;fc©SS#£>rL «S©:gfir A 1 0 6£fP±3-£ 5„ 

i-e-<Dsa«^5S(c$n-ci,^ 0 10 [0098] (2) mimim&z*Bt>ztifcmm±j& 

^^ra^ig^tos (micmfrti-z^z>mitti\ bx [0099.] ( 3 > (tut*. Jej^gjf* 

[0 08 9] 6 . ->XfA(D$^ -,-C. fHetf**«^ttffiB{C«« (WZ.it. fE£¥%& 

f-A 1 0 7 B. SfrltfBc «fc 0 , £±tttt»(C£-?T. [ 0. 1 0 0 ] ( 4 ) 1 1 0 4*6, *± 

tarn. **7fs. sr. M^^^-^ti sti^^ f ASDSiftm 

fSH10*i, ^^^»*«Dt«8 (IftiUr. flit ( 0 1 0 1 ] 6 . 5 h V-Z 

±^Wm^^A 1 0 7©&W, itLh^lrS^X-rA 1 20 S^^A©£^gS.rl,-;UB, iisoi^ %tfJB9& 

a** nn&s?gi i i i{cfe/c-r„ c©« mtfrh. wcmxs rgpj *iio«s5„ hv-* 
©*m*. 5. 3E«©ttaLfc»«3i^^?A©«flp4 © r&j jftisrag*? h^-^^isoru-s. 

[0 09 0] 6 . 2 afiigigf©±§-£ 3piB#.££ ?©ftg|^m£feHtttcttimKlk*f 1 ogl 

^-^xtcts-^waafi^i^tcB. raw*— n#ff &tciw?T^* rgj t rg^j as'io***. c© 

[0 09 1 ] »®«©SW&£:«:«fcS. **flttci»t* «^Xr-A«:*f UT. £©#£ <ttlKWig*flit>fc?f 

[0092] < i ) fHM*tn*g%&f<:Kr. so c o i o 2 ] t c s-c. e 1 5 oimmmtt* mm 

[0093] ( 2 > fBmtfftitf («* « . ®®zM^tcnmsfmji>-*mim<D 1 xitflf-c. 

£-#fi<©^WSIgK:SX*jtfWS) itiip?,, *7JKa fcB, Bfr <E>A^©^#^Khrag£ffi^L-Ct,>£>. C© 
sS»«cRT. «£©tttt3%cc&&ffitt. *J:c* ( r * * 

[0 094] ( 3 ) SLkJRKSl^a 1 1 0 4 Mfm "C^lg) *WT«C^r. 
««ji*D*i*5 *-Cf?«TS. * .[0103] 

( 1 ) ftittJb£KK^gt*&©R$a*0 

• mmms/mmmm (roo/ron 

• «liiJ:5S i ga>'^'rA©S^/a» ; (rlO/rll) 

• it±Ifl->^fA©lf/gS ( r 2 0 / r 2 1 ) 

( 2 ) ftji£8S©f£3Sltti« 

• &f**ft5}#0"Ct>-5/t,>£cl,> (r30/r3 1) 

• aX^SSAtCiac^/BJcat,^ <r40/r4 1) 

( 3 ) vtm&kvmmtft 

■ xmAl^ithr^f^/^iit^-C^h ( r 5 0/r 5 1 ) 

-Xtc. W£3B&mtr>i!>ftl£LtcA,-)\,VX h£^-f. is! « [0104] 

if (r01 & rll & r21 & r3l & r4* & r5*) then nO 
if (rOO & rXL & r2 1 & r31 & r4* & r5*) then nl 
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if (rOO & rU & r2 1 & 



if 
if 
if 
if 
if 
if 



(rOO & 
(rOl & 
(rOl & 
(rOl & 
(rOl & 
(rOl & 



rll & 

no & 
no & 
m & 

rll & 
rll & 



r21 
r2* 
r2* 
r2 0 
r2 0 
r2 0 



r30 & r40 & 
& r30 & r4l 



r5*) then n3 
& r5*) then n4 



7. 

MvXfA 1 0 6^6, DiiMJ^^S^x^A 1 0 7 

fc»<D*flia»»*«*rt»4 Q HI 6Klaf^U-*|l7S 
ffi®® 1 0 3 O^g^^-To m 1 6 SCircT<£ 5 

*ffi^MSffi 1 0 3«cttff*«M*^;U 110 7* 

CO 1 0 5] *3USM^>Xr-A«, ^c#<»ttS4 
( 1 ) aW^^Offift. (2 ) «bl±^(5Dtf®, 

(3 ) zf\Mi / m<Dmf£^ *> 3«8K>»fFe- F£f$o 

C 0 1 0 6 ] 7 . 1 l«*^CDffi«*- F 
*f;H 1 0 7*ca»r-S*-F-C*S. AttfttCK. 

[0107] CCC, ^U-$S0OSB«SfiI 

©«UI<DA#««, HMttJ (^^2-209562) 
AHWfc-"7«fc*l«J (#iSB^02 - 313 350) fSSgCD^ 

R = SpHq/Sq 
C = { (I p pi - p qi | + k 
= D/SpOq 

k :SR 

(n) , (12) S^6^©*Be^--rt/**a&6ns. * 

R>0 X 

c>e, 



& r3* & r4* & r5 1 ) then n2 

& r3* & r4* & r50 ) then n5 

& r31 & r4* & r5*) then n2 

& r30 & r40 & r5*) then n 3 

& r30 & r4l '& r5* ) then n4 

3**, ->x^ak:, (^*->B»> fig 

m^ici^^i. *ct, —a, cADf-^. 

20 7W-> 1 1 0 2£fflLT««7 s -^bLfc|£ 

CO 1 0 8 ] 2 5 

6X2 5 6 (BUS) ©lH»2fffl* 16X16 <S3ft) <D 

/Iv?* > K9K«tiLr, *->-f >F**flWK: ryr 

>|,*-f A— Wt'^XtfettlEj (^1^02-313350) fS 

30 [0 110] *r, ««^dr->©WB«r«TOJ:9CC 
[0111] ■«*6JBffiLfc»f*'<*--> : P 

>F^©iK*IS pnq© % Q*Jfiftibfc^ > F$ 
<D*gfa S q*C*f T £>itR£ SiST -5 0 
[0112] 5l^Mon^»J > FSWp 

40 (ppi, 0pi) , (pqi, 0qi) (Dp -a^rap^CDggSt 
[0113] 



I +k |.0pi-0qi | ) } /SpOq 



^ (0114] 



(11) 



(12) 



(13) 
(14) 



(15) 
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CC-C. (13) (14) S:*HB*«:«fcrjia^'«3'- 
> (Pi. Q.i) ©Jffi#-£fei±©*r. C*s&A£&£Q 

-[0115] 7. 2 ttatJbff*©!*®*- K 
HaLhfBt©fi-B*- F"CB. ^^©T-V-S-a > 

«. r3^7oSiR^j (i($g§^i-rL2374) {ctets^n 

"C«,»S. 10 
[011617. 3 tHBfBfc©30f *- F 
WiEfl5*©JtfT*- F-CB. fHie«f*^«:aJl/-r, fts 

ie*fT*«cawT*>ft4iMBH*©t^©WB> »*- 

[0117] 8 . ffllS 

;$->*-rA«. aKtSlf^ilSr* 0 . ft&Ji. & 
36*2i,»«:aPi«flP*ff5»-&«>*S. CO^tt^f- 

A*ss^-rs±-csgja©«. ( i ) 'gs^^-f-A*^ 20 

S#gll0 8^ j>$y*-zfflfflm&i 1 0 9% 
£> #. aflt^ffcWKIWF-r 4 C ii. ( 2 ) * 

-jhotww* i £ «c*jB-r ^ fc*©;*a©faf£#© 

<#5WWrc«. 901*7'* 1 10 7) ttlJ/XfA 

^sj mc*s. *?t. wawrit, mam? 

[0 118] (*3©SBfett) *»Wtt. f5Bg©»lB# 
KDNetatfBT**. ttaLUK«li'^-f-A*ilfc 

as&^ssaj («f«T3- 343947) i£3s©*a*f jitbvis 
— a$ij®^s 1216 icmmrz c t «c «fc 0 . 

i(x 5 ? -> a >© u - * atNStf &*tttr a e £ #r 

[0119] 40 
[#S9i©$»*] ##feW«:<fc*l«\ U-£©V* 

#©&ff1S:fc|6j±-r*. 
[BIi©tffl*fc!&9§] 

(SI] *»W©» 1 ©Sfi»W©RaMllfiS**T^n ? 
?B-e*£. 

[B 2 ] 0 1 «c^jos«©ai«»©»ii«(ijaff!**r ^ 
[ ia 3 ] 12 1 (cstntefio^osa^mir^ 

0 7*07*5. 50 
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[04] *^©ms^©*<*fl«i^«^^-r^m 

BT&5. 

[05] 0 1 «c«rsiiw©w»©»iiwtja«*5vr ^ 

a y ?0-c£>S„ 

[B6-] B 1 Kiftf+*«aBBt 1 0 1 ©Atttttti&ft 

[B8] ^W©<6©30S«KJ:S^-tr»U--3'WS 
CB9] *|SW«!«6«««:*5WSiSW««ttflF**f 7 

[bio] *«w©s«few<c*jtt*ffl[iw8aiw^«^r 
7n-ft- f-r*4. 

[Bll] *»98©ft<!!^tat««:J:4^ie*u-anW 
i->^f AO^n 7 ^0 

[112] B2 t£m?mMft<Dmft<Dum*7K??'CL ? 
[013] B3 Km?mm<Dtm<ofm*™T7vL 9 

^Bf*S. 

[Bl 4 ] ^f&^SytWcfcttSilM^n hruU^ 
"T^n ? ^0r*S o 

(B 1 5 ] *»E©3UWrTm»6h*3c±*ffl* » F 
"7-^©tt«S^B-C$>S. 
£ffrff©ttHi] 
1 0 1 4>^S^S 

1 0 2 unitf-n^s 

103 4-<*.V-9WrMW (^57 ^ vff-t xr?\s 
-O 

1 0 4 AiitfJiSg 

10 5 X U-^T- A AfflJTjiSS 

1 0 6 SMM->^fA (J41SfI->^fA) 

1 0 7 fBSURfcSf:*?* HfciUUMras/**-*) 

2 0 1 7X^7-A 

20 2 ^u-yy-A 

204. 224. 2 j4 #7- AAUtfjSB 

2 0 5 

206. 226. 2m6 * AAtB^^g 
2 0 7 ■Y.X'T -f v 2 

20 8. 228. 2 i 8 V a -f X-r -f ? t>X&tl&& 

209. 229. 2n9 !!<£ Xtf^S. 

2 1 0 B*&9&B 

2 11 ~> 5 ^ U-->a>^ 

2 1 3 7" utr*-# 

2 14A. 2 14B, 2 14C ffiS&ffl-felx-t 
216A, 216B. 216C T^.*x-£ 
2 1 7 AtH^SB 

217A.-217B, 217C fig^tf}-fe>-9" 

2 1 8 mmm^mms 

23 0 7;fal/-> 3 

2 6 0 ftMUbflp^S 



3 0 1 

4 0 1 
40 2 

5 0 1 
-5 0 2 
5 0 3 
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(16) #H¥6- 1 1 4 76 6 
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* 5 o 4 %tnm 

5 0 5 

50 6A. 50 6B. 5 0 6C, 50 6D, 5 0 6E 

7 o i mama 

* 7 0 2 ff#@S8 
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CPU 
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CPU 
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(17) 4ttB¥6-l 1 47 6 6 
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i®2) 
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[06] 
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CM 
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(19) 



- 1 1 4 7 6 6 



CH4] 





C20) 



4*H¥6 - 1 1 47 6 6 



t®7) 

SD 





C21) 
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[09] 



l 



~~ ' Y E S 



NO 



I 



I 



■ess -par 



— r 



NO 



< 



1 



( END 



YES 
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[0 1 0 ] 



( start 3 

" I 



£#3 



T3. 



TyEs 



NO 



T6 m lZKtf£V7T4 s t&-3 



NO 



< ^ 7 ^ > 



YES 



( END ) 
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